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Figure 2 - PRIOR ART 
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Start 
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Turn VCm off 



420 



Read in the ADC value through both Vvcm and 
VRsense paths as: ADC{Vref1) and ADC(Vref2) 
respectively 
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Apply a mall current towards the crash 
stop (Unload direction) 
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Select Vvcm input to the MUX and read in the 
ADC value as: ADC(Vvcm) - ADC(Vref1 ) 
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Select VRsense input to the MUX and read in 
the ADC value as: ADC(VRsense) - ADC(Vref2) 
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Calculate Kcal value such that: 
[ADC(Vvcm)-ADC(Vref1)] - Kcal.[ADC(VRsense)-ADC(Vref2)] = 0 
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Figure 4 
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Set Load Target Velocity as: 
V_Load_Target 



Receive Wcm & VRsense 
measurement 



Calculate back EMF, Vbemf as: 
Vbemf = (Wcm - Vref 1 ) - Kcal.(VRsense - Vref2) 



Calculate the velocity error as: 
V_Load_Target - Vbemf 



Do the loop compensation to obtain 
the desired control response and 
output control copmmand to VCM 



Wait for the next 
sample time 
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Unload 



Set Unload Target Velocity as: 
y_Unload_Tanget 



Receive Wcm & VRsense 
measurement 



13 

Calculate back EMF, Vbemf as: 
Vbemf = (Wcm - Vref1) - KcaI.(VRsense - Vref2) 



Calculate the velocity error as: 
V_Unload_Target - Vbemf 



Do the loop compensation to obtain 
the desired control response and 
output control copmmand to VCM 



Wait for the next 
sample time 



Done with the loading, Lock to 
track and continue 




Disable VCM 



Figure 5 
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Determine the value of the Voltage Err for 

this time period, 

Verr(n) 
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Calculate the value for the discrete control 
variable, Control(n) as: 

Control(n) = Control(n-l) + (Ki*T - Kp) * Verr 
+ Kp * Verr(n) 
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Send the discrete control variable, 
Control(n), to the driver circuit, which 
compensates the velocity of the header 
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Set the variables Control(n-l) and Verr(n-l) 
as: 

Control(n- 1) = Control(n) 
Verr(n-l) = Verr(n) 
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Figure 6 



